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基于 PSO-ELM 的 机 器 人 精度 补偿 方法 研究 ， 
BEH, ERR & F 


( 西 华 大 学 信号 与 信息 处 理 重 点 实验 室 , 成 都 610039) 


摘 要 : 为 了 提高 机 器 人 的 定位 精度 ， 对 传统 的 基于 神经 网 络 的 机 器 人 精度 补偿 方法 进行 改进 。 采 用 两 种 基于 粒子 群 
优化 的 极限 学 习 机 (PSO-ELM) 模型 的 精度 补偿 方法 对 机 器 人 关节 坐标 及 直角 坐标 进行 补偿 。 分 别 对 两 种 方法 进行 仿 
真实 例 分析 和 比较 ， 并 与 遗传 算法 优化 的 极限 学 习 机 (GA-ELM) 模型 进行 对 比 。 仿 真 结果 表明 ， 对 直角 坐标 进行 补 
偿 的 PSO-ELM 机 器 人 精度 补偿 法 优 于 其 他 补偿 方法 ， 且 具有 较 高 的 预测 精度 
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Research on methods of robot accuracy compensation based on PSO-ELM 


Feng Yuming, Dong Xiucheng, Jin Tao 
(Signal &Information Processing Laboratory, Xihua University, Chengdu 610039, China) 


Abstract: In order to improve the robot position accuracy, the traditional method of robot accuracy compensation based on 
neural network is improved. Two methods of robot accuracy compensation based on extreme learning machine with particle 
swarm optimization (PSO-ELM) are used to compensate for joint coordinate of robot and cartesian coordinate of robot. The two 
methods are analyzed and compared by simulation examples, and compared with the extreme learning machine with genetic 
algorithm optimization (GA-ELM) . The simulation results show that the method of robot accuracy compensation based on 


PSO-ELM compensates for cartesian coordinate is superior to other compensation methods, and has high prediction accuracy. 
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补偿 一 ; 另 一 种 以 关节 角 和 对 应 的 实际 坐标 位 置 偏离 作为 BP 神 
经 网 络 的 输入 和 输出 ， 再 通过 对 关节 角 进 行 补 偿 来 提高 机 器 人 
一 近年 来 ， 机 器 人 已 被 广泛 用 于 要 求 高 精度 的 工作 ， 如 离线 。 ”的 定位 精度 ”。 传 统 的 BP 神经 网 络 虽 然 在 机 器 人 的 实时 补偿 
编程 ， 机 器 人 辅助 手术 等 。 由 于 加 工 公 差 、 装 配 公差 、 机 器 人  ” 中 有 一 定 效 果 ， 但 是 由 于 自身 模型 的 限制 ， 容 易 陷 入 局 部 最 优 
的 结构 变形 等 多 种 原因 ， 使 机 器 人 的 实际 运动 学 模型 参数 和 它 。 解 ， | 练 时 间 较 长 ， 影 响 实时 补偿 的 效率 。ELM“ 是 Huang 
的 名 义 参 数值 不 同 。 这 种 误差 明显 降低 了 机 器 人 的 定位 精度 。 等 人 针对 传统 神经 网 络 算法 的 固有 缺点 提出 的 一 种 单 隐 含 层 前 
因此 ， 在 机 器 人 使 用 之 前 ， 机 器 人 应 进行 必要 的 校准 过 程 来 担 — 馈 神 经 网 络 的 学 习 算法 ， 与 传统 的 BP 算法 不 同 ，ELM 随机 产 
高 定位 精度 。 生 输 入 层 和 隐 层 之 间 的 连接 权 值 以 及 隐 含 层 神经 元 的 阔 值 。1 
机 器 人 运动 学 模型 的 误差 源 可 以 分 为 两 类 : 几何 参数 误差 ， “于 其 极 快 的 学 习 速 度 和 泛 化 性 能 好 等 优点 。 它 在 模式 识别 ， 计 
如 连 杆 长 度 和 连 杆 扭曲 误差 等 ， 非 几何 误差 ， 如 此 轮 侧 隙 、 连 。 算 机 视觉 ， 数 据 挖掘 ， 信 号 处 理 ， 和 控制 系统 中 得 到 了 广泛 的 
杆 和 关节 的 柔性 等 …”。 一 些 研究 专注 于 模型 的 建立 和 几何 参数 应 用 。 


gie 


E 


误差 的 辨识 而 忽略 了 非 几何 误差 5 "。 这 些 研 究 假设 非 几何 误差 本 文 将 粒子 群 (PSO) 和 极限 学 习 机 (ELM ) 相 结合 的 PSO- 
对 机 器 人 位 置 误差 影响 非常 小 。 但 这 些 非 几何 误差 仍然 会 影响 ELM 模型 对 上 述 的 两 种 基于 神经 网 络 的 机 器 人 精度 补偿 方法 
机 器 人 的 定位 精度 ”。 于 是 ， 有 些 学 者 提出 了 基于 神经 网 络 的 7 同时 引入 遗传 算法 (GA) 和 极限 学 习 机 (ELM) 


实时 误差 补偿 "。 这 种 方法 大 概 可 以 分 为 两 类 , 一 种 以 关节 角 ” 相 结 合 的 GA-ELM" 模 型 进行 对 比 ， 最 后 ， 再 对 改进 后 的 这 两 
和 对 应 关节 角 误 差分 别 作为 BP 神经 网 络 的 输入 和 输出 ， 得 到 ge 
在 任意 关节 角 时 的 误差 值 ， 通 过 修正 关节 角 来 实现 位 置 误差 的 
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1 ”极限 学 习 机 模型 
ELM 的 网 络 训练 采 用 单 层 的 隐 层 前 馈 


n 个 输入 层 神 经 元 和 o 个 输出 输 旦 
设置 了 
1<i<N, 


R. BEEE 
ERA, DIER 7 个 输 
招 含 层 神 经 元 数 为 六 。 假 设 有 N 


= 


ET 


入 变量 和 。 个 输出 变量 ， 
个 不 同 的 样本 (5.0)， 


x] € R",t, -[t,.t,.... 


stol e 8 ELM 的 训练 模型 如 图 1 


X» -— [xi 2 


所 示 : 


hn ho 
Input Layer Output Layer 


Hidden Layer 


图 1 ELM 的 训练 模型 
ELM 的 网 路 模型 可 以 表达 如 下 : 


h 
$ Bs(wx *b)or.j71,2..0 (1) 
i=l 


其 中 : w w] 是 所 有 输入 层 神 经 元 连接 第 i 个 隐 层 神 
经 元 之 间 的 输入 权 值 向 量 ，4& 是 第 i 层 隐 层 神经 元 的 阐 值 。 
B - [Bs Ba Ba] 是 第 i 个 隐 层 神经 元 连接 所 有 输出 神经 元 的 权 
值 向 量 ，y=[7i,72…7%] 是 ELM 的 输出 值 。 代 价 函数 可 以 表 


示 如 下 : 


= [W wa. 


«(ua 2) =È -1| a 


WB=[w,b,i=1,2,.… 有 1 训练 ELM 的 目标 是 找到 最 优 的 WB 和 8 使 
得 输出 值 和 实际 值 的 误差 最 小 ， 所 以 ，minC(WB,p) 可 以 被 写 
作 以 下 的 形式 : 

min C (WB, £) = min „p p |H (wi... 
其 中 : H 是 样本 中 隐 层 神 
PERIERE o 


Wysby s Diss x.) —T| 


经 元 的 输出 矩阵， 


(3) 
ERRAI H 


T ER 


H(w,, Ww, Ww; bis bastits 


g(wx +b) =e 


b, Xp 
8w,x, +b,) 


Xy) = 
(4) 


&(w,xy +b,) INxh 


乘 解 ， 即 求 使 得 代价 函 


gx, tb) … 
FTA G) 等 价 于 求 88=7 的 最 小 二 
最 小 的 最 优 权 值 b， 


" 
B-H'T (5) 
H+ Æ H If] Moore-Penrose J ^ X 3E jp [E 


2 基于 PSO 优化 的 ELM 算法 


粒子 群 优 化 算法 由 Eberhart 和 Kennedy 基于 人 和 群 
行为 理论 提出 的 "， 该 算法 作为 一 种 新 兴 的 进化 算法 ， 
鸟 类 砚 食 的 模拟 ， 对 于 YX 个 参数 的 最 优 辨识 
于 实现 的 特点 。 


的 社会 
起 源 于 
有 原理 简单 ， 易 


根据 ELM 的 基本 原 
含 层 阔 值 矩阵 2 
会 造成 ELM 的 预测 误差 很 大 ，PSO 具有 
局 寻 优 能 力 ,PSO 可 以 为 ELM 模型 找到 


”和 隐 
的 情况 下 ， 


从 而 得 到 最 优 


进行 归 


7$ 
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ELM 模型 。 


a) 实验 数据 的 预 处 理 。 
化 。 
b) 初始 化 。 初 始 化 粒子 群 


Wi j=l, 


经 元 之 间 的 连接 权 值 ， 

c) 寻找 初始 极 值 。 将 粒子 位 置 X' 和 训练 样 
ELM 模型 ， 得 到 ELM HJH H 
寻找 个 体 极 值 和 和 群 


度 值 。 


k Tel 
, 


: 第 i 个 粒子 位 置 X, 2 [Ws wj 


E ii 


PSO-ELM 算法 的 3 


最 优 的 初始 


法 研究 


理 可 以 看 出 ELM 的 输入 层 权 值 矩阵 
是 随机 生成 的 , 因此 , 在 ELM 模型 
良好 的 全 
iq, 


4 固定 


要 步骤 如 


将 实验 数据 分 为 训练 集 和 测试 集 ， 


hist Matt Wino D pts b,] 


预测 值 ， 
体 极 值 ， 同 时 记 


Sh 


屋 神 经 元 的 闵 值 。 


E 


极 值 的 位 


及 适应 度 1 


直 。 粒 子 的 适应 度 


函数 取 为 


其 中 : ?为 训练 样 
本 的 个 数 。 


"AMARE 


d) 惯性 


E 


本 的 ELM 输出 预测 值 , Y. 为 训练 样 


的 选择 。 在 经 过 一 些 迁 代 后 ， 


参数 ，ELM 模型 的 网 络 结构 参 
， 其 中 ， 
i 个 输入 层 神经 元 与 第 7 个 隐 
ETE 


层 神 


本 数据 代入 
从 而 计算 出 粒子 的 适应 
忆 个 体 极 值 和 群体 


(6) 


本 的 真 值 ， 


每 个 粒子 的 位 置 


逐渐 收敛 到 最 佳 位 
迭代 的 局 部 优化 能 力 ， 惯 性 


减 小 。 


其 中 : 
迭代 次 数 


e) 迭代 寻 优 。 每 次 迭代 的 过 程 中 ， 
自身 的 速度 和 位 置 ， 最 终 得 到 最 优 个 体 的 适 


群体 极 值 更 新 


Omax 和 Pmi 


。 为 了 提高 前 


pE 


j—1 
jj 


是 最 惯性 


值 和 对 应 的 粒子 位 置 。 


f) 完成 


ELM 的 最 优 网 络 初始 权 值 和 


PSO-ELM 模 


lOr = Orin 


J-1 


权重 的 最 大 值 和 最 小 值 ，/ 是 


粒子 通 


CRA E mer 
试 集 样 本 对 ELM 进行 测试 及 效果 评价 。 
PSO-ELM 的 算法 流程 如 图 2 所 示 。 
PS0 优 ik Ši 
IETA 优化 算法 部 分 ELM 部 分 
粒子 和 速度 初始 化 [< 一 一 一 EENAA 
数据 预 处 理 I——4 
粒子 适应 度 计算 DAKEN 
BUBGRnEDR 
寻找 个 体 极 值 和 群体 极 什 
获取 最 优 网 络 
[人 初始 权 值 和 阅 什 
pue 
更 新 训练 网 络 。 [< 一 一 
or BEREE 
y 
个 体 极 值 和 群体 N 
极 值 更 新 HEERKE? 
N Y d 
FERIERE 仿真 预测 


四 2 PSO 优化 ELM 的 算法 流程 


期 欠 代 的 全 局 搜索 能 力 后 期 
E co pitis [e Uoc 7 的 增加 而 线性 


() 


是 最 大 的 


过 个 体 极 值 和 


应 度 


型 。 最 优 个 体 对 应 的 粒子 位 置 即 是 


ul 


闵 值 ， 将 其 代入 ELM 模型 ， 


131] 
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3 ”基于 PSO-ELM 的 机 器 人 精度 补偿 仿真 实例 


3.1 ABB 机 器 人 的 几何 模型 
本 文采 用 DH 法 建立 ABB 机 器 人 的 运动 学 模型 ，ABB 机 
器 人 的 结构 图 如 图 3 所 示 。 


DS 


PS 


3 ABB 机 器 人 的 结构 区 
在 建立 了 坐标 系 0 后 ， 从 坐标 系 1 开始 ， 通 过 


使 用 坐标 系 


i-1 来 定义 坐标 系 i, 两 个 相 邻 的 连 杆 的 DH 坐标 系 的 齐 次 变换 
矩阵 如 下 
T^ = Rot(z,0 )Trans(0,0,d;)Trans(a,,0,0) Rot (x, a) (8) 
可 以 得 到 ; 
cosO —sinO cosa,  sinOsino;  a,cosÓ 
i1; | SinQ,  cosQ cosy, -cos0 sina, a,sin6, 
0 sin a; COS Qr, d; 
0 0 0 1 
其 中 : 2.2.4.0 分 别 表示 第 i 个 轴 的 连 杆 长 度 , 连 杆 扭曲 , 连 杆 
偏 置 和 关节 和 角度。 给 定 ABB 机 器 人 的 标准 D-H 参数 值 如 表 1 
所 示 ， 其 中 ，@ 、4 的 单位 为 mn， 、9 的 单位 为 rad 。 
表 1 标准 D-H 参数 值 
i d; a; d, 6, 9 的 范围 
1 0 —pi/2 187 0, -165' —165 
2 230 0 0 0, -110° ~110 
3 107 -pil2 0 0, -90 — 70 
4 0 pi/2 168 0, —160' —160 
5 0 —pi/2 0 O; -120° ~ 120 
6 0 0 0 Os -400 ~ 400 
用 * 表 示 sinb ，6 表示 cosQ ， 由 表 1 可 得 ， 各 连 杆 的 变换 
矩阵 如 下 
c 0 -s 0 [c, -s, 0 230c 
Ta = s 0 «q 0 , n- $, c, 0 230s, : 
0 -1 0 187 1 0 
0 0 0 | L 0 0 1 


0 0 

se c, 00 

1.0 

0 0 0 1 
将 各 个 连 杆 的 变换 矩阵 相 乘 ， 就 可 以 得 到 机 械 手 末 端 相对 
于 基 坐 标 系 的 变换 矩阵 ; 


0 0 0 
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n, O0, a. p, 
n [2] a. j 
TR RERIT =|” > S >| qus 
n o, d, p 
0 0 0 1 


机 器 人 的 末端 位 置 向 量 可 以 表示 为 x e ,机 器 人 
的 末端 位 置 误差 可 以 表示 为 AX = JA e Ay! e Az ， 若 用 上 角 标 字 
母 YX 表示 理论 值 ， 字 母 R 表示 实际 值 。 则 位 置 总 误差 可 以 表示 
HA - ipt - pYY e(t - pTY (f 
3.2 ”实验 数据 的 获取 
假设 表 1 中 ABB 机 器 人 相应 的 标准 D-H 参数 值 的 几何 误 
差 如 表 2 所 示 。 其 中 ，Aa,; 、Ad， 的 单位 为 wn ，Aa, 、A9 的 
单位 为 rad 。 即 ABB 机 器 人 的 实际 D-H 参数 af =a+Aa， 
af =a+Aa, d'-d,c^d,, 0" 


表 2 标准 D-H 参数 值 的 几何 误差 


-py. 


n 


-6 +40, o 


i Ad; Ad; Ad; A6, 

1 0.1 0.0015 0.15 -0.0016 
2 0.12 0.0018 0.08 0.0018 
3 0.15 0.0016 0.10 0.0015 
4 0.08 0.0015 0.14 0.0013 
5 0.09 0.0014 0.08 -0.0012 
6 0.06 0.0017 0.09 0.0015 

根据 机 器 人 各 个 关节 角 的 变化 范围 以 及 实际 工作 的 需 
W, Wa =-60,0,60 , 0,—30,40,50 , 0,—-10,20,30,40' , 


0, = -60 ,-40 ,20 ,40 ,60 ， 0, =-60 ,-40 ,20 ,40 ,60 ， 


0, = -90 ,-60 ,-30 ,30 ,60,90 。 一 共产 生 3x3x4x5x5x6=5400 组 
不 同 的 关节 角度 组 合 ， 其 中 5000 组 作为 ELM 模型 的 训练 村 
本 集 ， 另 外 400 组 作为 检验 的 数据 。 

3.8 ”对 关节 坐标 补偿 的 PSO-ELM 机 器 人 精度 补偿 法 

对 关节 坐标 补偿 的 PSO-ELM 机 器 人 精度 补偿 模型 将 机 器 
人 的 理论 关节 角 作 为 PSO-ELM 模型 的 输入 ， 关 节 角 误差 作为 
输出 来 训练 PSO-ELM 模型 。 PSO-ELM 训练 过 程 的 框图 如 图 4 
所 示 。 其 中 , 0"-[8,6,6,0.0.6,] , e"-[a*.07.07.07.07.07] , ABB 
机 器 人 理论 关节 角 6* 经 正 运动 学 (理论 D-H 参数 ) 计算 得 出 理 
VERO LET? ,理论 末端 位 姿 经 逆 运 动 学 (实际 D-H 参数 ) 求 
解 得 实际 关节 角 0^, 于 是 可 得 关节 角 误 差 Ab=2 -0" 。 故 PSO- 
ELM 模型 的 输入 层 节 点 为 6， 输 出 层 节 点 也 为 6。 


Hn 


T 


i Fo 实际 DH 
e 参数 的 
A 机 器 人 


全 4 机 器 人 关节 坐标 补偿 的 PSO-ELM 训练 模型 

可 以 使 用 图 5 中 描述 的 步骤 来 执行 机 器 人 来 端 执行 器 的 定 
位 过 程 。 其 中 ，6"” 是 经 过 补偿 后 的 修正 的 关节 角 ，X" 是 预测 
位 置 ， 我 们 的 目标 是 将 机 器 人 末端 执行 器 移动 到 其 工作 空间 中 
的 理论 位 置 x* 。 甚 中 = 是 机 器 人 精度 的 上 限 。 
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其 做 对 比 ,GA-ELM 利用 遗传 算法 为 ELM 寻 
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图 5 


机 器 人 关节 坐标 的 补偿 过 程 
为 了 体现 该 模型 的 准确 性 和 优越 性 
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GA-ELM 模型 与 
找 最 优 的 ”和 总 ， 


具体 的 算法 流程 参考 文献 ,经 过 多 次 实验 , 确定 PSO-ELM 的 
隐 含 层 节 点 数 为 68, 种 群 规 模 为 40, 迭代 次 数 为 300, 6 = 62, 


max , min 


Os, 为 0.9, 最 小 值 wm 


Van =l , popmax-2, 


popmin=-2 ， 惯 性 
,为 0.4,GA-ELM 的 隐 含 


权重 的 最 大 值 
层 节 点 数 为 58， 


种 群 规模 为 100， 和 迭代 次 数 为 330， 交 叉 概 率 为 0.6， 变 异 概率 


为 0.01. ELM 的 隐 含 层 激励 函数 均 选 择 “sig” 函 数 。 用 5000 组 
样本 集训 练 模型 ， 将 400 组 检验 数据 代入 训练 好 的 模型 ， 经 过 
机 器 人 道 运动 学 精度 补偿 后 的 位 置 误差 如 图 6 所 示 。 
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图 6 位 置 误差 (400 组 检验 数据 ) 

为 了 验证 输入 数据 的 一 般 性 , 根据 机 器 人 实际 工作 的 需要 ， 


9, 


6, 


E, Max 5400 组 数据 中 随机 生成 200 28 4 
的 PSO-ELM 进行 仿真 计算 ， 位 置 误差 如 图 


在 机 器 人 各 个 关节 角 的 变化 范围 以 内 ， 
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7 所 示 。 
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x7. 位 置 误差 (200 组 随机 数据 ) 


3.4 对 直角 坐标 补偿 的 PSO-ELM 机 器 人 精度 补 
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理论 关节 角 作 为 PSO-ELM 模型 的 输入 ， 实 际 
误差 作为 输 
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本 数据 不 同 的 5400 组 数 
E, 代入 已 训练 完成 
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图 8 


训练 后 的 


机 器 人 末端 执行 


器 人 运动 的 位 


图 8 所 示 。 REB, 8" -[8.6,.6,.6,.6,.6,] , 
正 运动 学 〈 理 论 D-H 参数 ) 计算 得 出 理论 的 末端 位 置 
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正 运 动 学 (实际 D-H 参数 ) 计算 得 
[x*,y*,z*|] ， 于 是 可 得 位 置 误差 AX 2x" 一 X*。 
4 的 输入 层 节点 为 6， 输 出 层 节 点 为 3。 
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机 器 人 直角 坐标 补偿 的 PSO-ELM 训练 模型 
PSO-ELM 模型 将 用 于 补偿 机 器 人 的 位 置 误差 。 
器 定位 的 详细 步 又 如 图 9 所 示 ， 由 于 ABB 机 
只 与 前 AREA, G, OAR, WMA 


的 补偿 只 针对 
的 雅 可 比 矩 阵 


机 器 人 末端 执行 
度 的 上 限 。 
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前 3 AREH, Jo 是 机 器 人 关节 变量 9(i=1,2,3) 
“是 经 过 补偿 后 的 关节 角 ， 实 验 的 目标 是 将 
器 移动 到 其 工作 空间 中 的 理论 位 置 


, 9m 


X", HH 


x 


AX gan 
e trained "IETEPEEN 
$ EM 9" - o «(1,) (-AX) B 


为 了 体现 该 模型 的 ; 
其 做 对 比 ， 经 过 多 次 实验 ， 确 定 PSO-ELM 
65, RHENUS 50, 3x 
为 0.9， 最 小 值 wm 
层 节 点 数 为 73， 种 群 规模 为 80， 和 迭代 次 数 为 400， 交 叉 概 率 为 
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图 9 机 器 人 直角 坐标 的 补偿 过 程 

佳 确 性 和 优越 性 ] GA-ELM 模型 与 
的 隐 含 层 节点 数 为 
尺 次 数 为 300， 惯 性 权重 的 最 大 值 Onax 
,为 0.4， 其 他 参数 同上 文 。GA-ELM 的 隐 含 


HÀ 
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0.6, 变异 概率 为 0.01,ELM 的 隐 含 层 激 励 函 数 均 选 择 sig 函数 。 


用 5000 En 将 400 组 检验 数据 代入 训练 好 的 
模型 ， 经 过 机 器 人 逆 运 动 学 精度 补偿 后 的 位 置 误 差 如 图 10 所 
示 。 
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图 10 ”位置 误 差 (400 组 检验 数据 ) 
为 了 验证 输入 数据 的 一 般 性 ， 将 与 上 文 相同 的 随机 生成 的 
200 组 数据 , 代入 已 训练 完成 的 PSO-ELM 进行 仿真 计算 , 位 置 
误差 如 图 11 所 示 。 
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ud | 提出 对 机 器 人 的 关节 坐标 补偿 和 直角 坐标 补偿 两 种 方法 ， 采 用 
TE ' o CE 粒子 群 优化 算法 优化 的 极限 学 习 机 模型 (PSO-ELM ) 预测 关节 


ETE t EEFI a 
sil t t t 


tab Venet 坐标 的 误差 和 直角 坐标 的 误差 ， 并 与 遗传 算法 优化 的 极限 学 习 
E 机 (GA-ELM) 模 型 进行 对 比 。 在 这 两 个 仿真 实验 中 ，PSO-ELM 
P 的 预测 效果 都 优 于 GA-ELM。 而 对 机 器 人 直角 坐标 补偿 的 方法 
s 要 明显 优 于 对 关节 坐标 补偿 的 方法 。 对 直角 坐标 进行 补偿 的 
eil PSO-ELM 精度 补偿 法 的 预测 精度 最 高 , 且 具 有 良好 的 鲁 棒 性 。 
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